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» . OBSTACLE DETECTION SYSTEM FOR AUTOMOTIVE VEHICLE 

CROSS-REFERENCE TO RELATED APPLICATION 
This application is based upon and claims benefit of 
5 priority of Japanese Patent Application No. 2002-368902 filed 

on December 19, 2002, the content of which is incorporated 
herein by reference. 

BACKGROUND OF THE INVENTION 

10 1. Field of the Invention 

The present invention relates to a system mounted on 
an automotive vehicle for detecting an obstacle such as a 
preceding vehicle by emitting radar beams and receiving beams 
reflected by the obstacle. 

15 2. Description of Related Art 

An 'example of an obstacle detecting system mounted 
on an automotive vehicle is shown in JP-A-2002-40137 . In 
this system, radar beams such as light beams or millimeter- 
wave beams are emitted toward an obstacle such as a preceding 

20 vehicle, and beams reflected by the obstacle are received. 

Based on the reflected beams received by the system, a 
distance from the vehicle carrying the system to the 
preceding vehicle is detected. For example, if the distance 
between two vehicles becomes too short, a warning is given to 

25 a driver of the vehicle carrying the system, or the distance 

between two vehicles are maintained not to become shorter 
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than a predetermine distance by controlling a traveling speed 
of the vehicle. 

Laser beams are emitted while scanning in both the 
horizontal and vertical directions, thereby detecting an 
obstacle such as a preceding vehicle located in a 
predetermined scanning area. The distance to the preceding 
vehicle and its angular direction relative to a direction in 
which the vehicle carrying the system is traveling are 
detected based on the laser beams reflected by the preceding 
vehicle. In other words, the preceding vehicle is detected 
as plural dots reflecting the laser beams. The horizontal 
width and the vertical height of the obstacle such as a 
preceding vehicle are detected based on the horizontal angle 
of reflected beams and the vertical angle of the reflected 
beams, respectively. 

More particularly, after one scan in the horizontal 
direction is completed, the vertical angle of the beam is 
changed by a certain angle and the next horizontal scan is 
carried out. This process is repeated until all' the scanning 
area is covered. After one horizontal scan is completed, the 
plural dots reflecting the laser beams, which fall within a 
certain distance range from the vehicle carrying the 
obstacle-detecting system and within a certain width range in 
the horizontal direction, are grouped into .presegment data. 
Further, the presegment data obtained by scanning each 
horizontal scanning line, which are close to one another, are 
grouped into main segment data. The presegment data and the 



main segment data include only a limited number of the 
reflecting dots detected in the scanned area to save a memory 
capacity in a RAM and to shorten data processing time. 

When the vehicle is traveling on a curved road, a 
5 preceding vehicle is not detected in the center of the 

horizontal scanning range, but it will be detected at a 
fringe of the horizontal scanning range. To cope with this 
situation, a reference angular direction from which the 
grouping operation to form the presegment data is initiated 

10 is calculated ba'sed on a radius of the curved road. The 

reference angular direction extends to a point on the curved 
road where the preceding vehicle is most probably located. 
Thus, the presegment data are formed from the reflecting dots 
located close to the reference angular direction. 

15 In the system disclosed in JP-A-2002-40137 , the 

reference angular direction is calculated based on only the 
radius of the curved road. It is difficult, however, to 
assume the position on the curved road where the preceding 
vehicle is most probably located based on only the radius of 

20 the curved road. When the preceding vehicle is traveling on 

the curved road having a given radius, it will be most 
probably detected at a position closer to the fringe of the 
scanning angular range if the distance between two vehicles 
is large. On the contrary, if the distance is not large, the 

25 preceding vehicle will be detected at a position closer to 

the center of the scanning range even when the preceding 
vehicle is traveling on the curved road having the same 
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radius. The distance between the vehicles is also important 
to correctly assume the position of the preceding vehicle in 
addition to the radius of the road. Therefore, it has been a 
problem in the system disclosed in JP-A-2002-40137 that the 
5 presegment data representing the preceding vehicle cannot be 

satisfactorily formed. 

SUMMARY OF THE INVENTION 
The present invention has been made in view of the 

10 above-mentioned problem, and an object of the present 

invention is to provide an improved obstacle detection system 
which is able to detect a preceding vehicle more surely even 
when the preceding vehicle is traveling on a curved road. 

The obstacle detection system mounted on an 

15 automotive vehicle according to the present invention 

includes a radar sensor such as a laser radar sensor and an 
electronic control unit for processing the data sensed by the 
radar sensor. Radar beams such as laser beams are emitted 
ahead of the vehicle on which the obstacle detection system 

2 0 is mounted. A predetermined two dimensional area ahead of 

the vehicle is scanned by the radar beams, and the reflected 
beams are returned to the sensor from the frontal obstacle 
such as a preceding vehicle. The obstacle is detected as 
plural reflecting dots. The electronic control unit 

25 processes the reflecting dots, and thereby the position of 

the obstacle is detected. 
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To detect the preceding vehicle even when the 
preceding vehicle is traveling on a curved road, a reference 
distance is set according to the driving speed of the own 
vehicle on which the system is mounted. The reference 
5 distance is set longer as the vehicle speed becomes higher. 

Also, a radius of the curved road is calculated based on the 
various data sensed by the sensors mounted on the vehicle. A 
point apart from the own vehicle by the reference distance is 
set on the curved road having the calculated radius. A 

10 reference angular direction is set on a line connecting the 

point set on the curved road and the own vehicle. It is most 
probable that the preceding vehicle is found in the reference 
angular direction. 

The reflecting dots located close to the reference 

15 angular direction are searched and grouped into a target 

model. Since the number of reflecting dots to be grouped is 
limited in order to save a memory capacity and to shorten a 
processing time, it is effective to search around the 
reference angular line where the preceding vehicle is most 

20 probably located. If the preceding vehicle is continuously 

observed for a predetermined period and if the calculated 
radius of the curved road is smaller than a predetermined 
value (i.e., if it is presumed that the road is not straight), 
the reference angular direction is set on a line connecting 

25 the observed preceding vehicle and the own vehicle. 

The reflecting dots for forming the target model may 
be selected sequentially from those located closer to the 
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reference angular direction until the number of selected 
reflecting dots reaches the predetermined number. 
Alternatively, one reflecting dot may be selected from one 
side of the reference angular direction and the next 
5 reflecting dot from the other side. This process may be 

repeated until the number of the reflecting dots selected 
reaches the predetermined number. 

According to the present invention, the preceding 
vehicle can be surely detected even when it is traveling on a 
10 curved road. Other objects and features of the present 

invention will become more readily apparent from a better 
understanding of the preferred embodiment described below 
with reference to the following drawings. 

15 BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is a block diagram showing a vehicle control 
system including an obstacle detection system according to 
the present invention; 

FIG. 2A is a block diagram showing a laser radar 
20 sensor used in the obstacle detection system; 

FIG. 2B is a graph showing an emitted laser pulse 
and a reflected laser pulse; 

FIG. 3 is a perspective view showing a detection 
area scanned by the laser radar beams; 
25 FIG. 4A is a flowchart showing a process of 

detecting an obstacle; 
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FIG. 4B is a flowchart showing a process of forming 
a target model; 

FIGS. 5A and 5B are graphs for explaining a process 
of forming presegment data; 
5 FIG. 6 is a schematic view showing a reference 

angular direction set on a curved road; 

FIG. 7 is a graph showing a method of calculating 
an objective beam number; 

FIG. 8 is a conceptual diagram showing an order of 
10 grouping data into presegment data, which is initiated at an 

objective beam number; and 

FIGS. 9A and 9B are graphs for explaining a process 
of 'forming main segment data from the presegment data. 

15 DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENT 

A preferred embodiment of the present invention will 
be described with reference to the accompanying drawings. 
FIG. 1 shows a vehicle control system that includes an 
obstacle detection system according to the present invention. 

2 0 The vehicle control system 1 is mounted on an automotive 

vehicle and includes an ECU (electronic control unit) 3 and 
various input/output interfaces . Since these hardwares 
included in the vehicle control system 1 are known ones, 
their explanations in detail are not made here. 

25 Signals from a laser radar sensor 5, a vehicle speed 

sensor 7, a brake switch 9, and a throttle sensor 11 are fed 
to the ECU 3. Signals for driving an alarm generator 13, a 
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distance display 15, a malfunction display 17, a brake driver 
19, a throttle driver 21 and an automatic transmission 
controller 23 are supplied to these devices. An alarm volume 
setter 24, an alarm sensitivity setter 25 that sets a 
sensitivity level in a process of alarm generation, a cruise 
control switch 26, a steering sensor 27 that detects an 
amount of steering, and a yaw rate sensor 28 that detects a 
yaw rate generated in the vehicle are also connected to the 
ECU 3. Operation of the ECU 3 is initiated by turning on a 
power switch 29. 

The laser radar sensor 5 is shown in FIG. 2A in 
detail. The laser radar sensor 5 is composed of an emitter, 
receiver, a radar CPU 70 and other associated components. 
The emitter includes a semiconductor laser diode 75 that 
emits laser pulses through an emitting lens 71, a scanner 72 
and a glass plate 77. The laser diode 75 connected to the 
laser radar CPU 70 through a laser diode driving circuit 7 6 
is driven by a driving signal supplied from the laser radar 
CPU 70. The scanner 72 includes a polygon mirror 73 that 
rotates around a vertical axis when a driving signal is fed 
from the laser radar CPU 70 through a motor driver circuit 74. 
Rotational positions of a motor (not shown) for driving the 
polygon mirror 73 are detected by a motor position sensor 78 
and are fed to the laser radar CPU 70. 

Since the polygon mirror 73 has six mirrors, each 
having respectively different slant angles relative to the 
vertical direction, the laser beams can be scanned in the 
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horizontal and the vertical directions. The laser beams are 
emitted in a form of discrete pulses. An area scanned by the 
laser beams (an detection area 91) is shown in FIG. 3. A Z- 
axis is set to the traveling direction of the vehicle on 
5 which the laser radar sensor 5 is mounted. An X-Y plane 

perpendicular to the Z-axis is the plane to be scanned. The 
X-axis extends in the horizontal direction, or the direction 
in parallel to the width of the vehicle. The Y-axis extends 
in the vertical direction, or the direction in parallel to 

10 the height of the vehicle. 

As shown in FIG. 3, the first scanning line is set 
at the top portion of the detection area 91, and the scanning 
is performed from the left to the right in the X-axis 
direction. After the scanning along the first scanning line 

15 is completed, the scanning moves to the second scanning line. 

This process is repeated until the scanning reaches to the 
bottom scanning line. In this particular embodiment, a 
scanning angular range in the X-direction is 15.75° (0.15° x 
105 dots), and a scanning range in the Y-direction is 4.2° 

20 (0.7° x 6 lines). Namely, the laser beam in a pulse form is 

discretely emitted to 105 points on each scanning line in the 
X-direction, and the laser beam is shifted in the Y-direction 
until 6 scanning lines are all scanned. Thus, 630 (105 x 6) 
discrete laser beams are emitted to scan the entire detection 

25 area 91. In other words, 630 data are obtained by scanning 

the entire detection area. 
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A pattern 92 of the laser beam is oval in this 
embodiment, as shown in FIG . 3. However, the laser beam 
pattern 92 is not limited to the oval shape, but it may be a 
round shape or other shapes. The beam is not limited to the 
5 laser beam, but other beams such as a millimeter 

electromagnetic wave or an ultrasonic wave may be used. 

By scanning the two-dimensional detection area 91 
and receiving reflections from a target object, a distance 
between the laser radar sensor 5 and the target object in the 

10 Z-direction is obtained based on a period of time between a 

time emitting the beam and a time receiving its reflection. 
Also, a horizontal scan angle 9 X and a vertical scan angle 9 y 
are obtained. The horizontal scan angle 0 X is defined as an 
angle between the Z-axis and an emitted beam line projected 

15 on the X-Z plane. The vertical scan angle 6 y is defined as 

an angle between the Z-axis and an emitted beam line 
projected on the Y-Z plane. 

Referring to FIG. 2 again, processing of the 
reflected beams will be described. The laser beam reflected 

20 by an obstacle (or a target object) is received by a 

receiving lens 81 in the receiver and is fed to a receiving 
element 83. The receiving element 83 outputs a voltage 
proportional to the received reflection. The output of the 
receiving element 83 is fed to an amplifier 85, and then to a 

2 5 comparator 8 7 that compares the output voltage from the 

amplifier 85 with a reference voltage. If the output voltage 
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is higher than the reference voltage, a predetermined signal 
is sent to a time measurement circuit 89. 

The laser diode driving signal from the laser radar 
CPU is also fed to the time measurement circuit 89. As shown 
in FIG. 2B, a pulse PA emitted at time TO is reflected by the 
obstacle and a reflected pulse PB is returned at time Tl. 
The time measurement circuit 89 calculates a time difference 
AT between time Tl and time TO and converts the calculated 
time difference AT to a binary digital signal. The laser 
radar CPU 70 calculates a distance r from the detection 
system (the vehicle on which the detection system is mounted) 
to the obstacle based on the time difference AT. The laser 
radar CPU 70 formulates position data (X,Y,Z) in the three- 
dimensional orthogonal coordinate having its origin (0,0,0) 
at the position of the laser radar sensor 5, based on the 
distance r, the horizontal scan angle 0 X and the vertical 
scan angle 0 y . The calculated position data (X,Y,Z) are fed 
to the ECU 3 (shown in FIG. 1) . 

The ECU 3 detects and recognizes the obstacle based on 
the position data (X,Y,Z) and operates various driving 
devices and alarms according to the situations of the 
detected obstacle. Namely, the distance from the vehicle to 
the obstacle is controlled by operating a brake driver 19, a 
throttle driver 21, and an automatic transmission controller 
23 in a controlled manner. If necessary, the ECU 3 outputs 
signals to operate alarming devices. 



Referring to FIG. 1, operation of the ECU 3 will be 
described. The position data (X,Y,Z) outputted from the 
laser radar sensor 5 are fed to a block 43 for formulating a 
target model. The target model formulating block 43 performs 
5 grouping operation to obtain presegment data and main segment 

data. Each obstacle located in front of the vehicle is 
represented by the main segment data. The grouping operation 
will be explained later in detail. Based on the main segment 
data obtained for each obstacle, a center position (X,Y,Z) of 

10 the obstacle and a size of the obstacle (W,D,H) are 

calculated. W is the width of the obstacle in the X- 
direction, D is the depth in the Z-direction and H is the 
height in the Y-direction. Further, a speed (Vx,Vy,Vz) of 
the obstacle relative to the vehicle is calculated based on 

15 changes in the center position (X,Y,Z,). 

Further, the target model formulating block 43 
determines whether the obstacle is a stationary obstacle or a 
moving obstacle such as a preceding vehicle, based on the 
vehicle speed fed form the vehicle speed calculating circuit 

20 47 and the calculated relative speed (Vx,Vy,Vz) . The data 

constituted by the center position (X,Y,Z), the size (W,D,H) 
and the relative speed (Vx,Vy,Vz) are referred to as a 
"target model." 

A malfunction detector 44 determines whether or not 

25 the target model formulated in the block 43 includes any 

abnormal data. If abnormal data are included, such is 
displayed on a malfunction display 17. The steering angle 
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calculating circuit 49 calculates a steering angle based on a 
signal fed from the steering sensor 27. The yaw rate 
calculating circuit 51 calculates a yaw rate of the vehicle 
based on a signal fed from the yaw rate sensor 28. A curve 
5 radius calculating circuit 57 calculates a radius R of a 

curved road based on the vehicle speed fed from the circuit 
47 and the yaw rate fed from the circuit 51. The curve 
radius R outputted from the curve radius calculating circuit 
57 and the vehicle speed outputted from the vehicle speed 

10 calculating circuit 47 are used in the target model 

formulating block 43 for determining a point to initiate the 
grouping operation. This will be explained later in detail. 
Further, the target model formulating block 43. calculates a 
vehicle probability (a probability in that the detected 

15 obstacle is a preceding vehicle) and a same lane probability 

(a probability in that the preceding vehicle is on the same 
lane as the own vehicle) , based on the data included in the 
target model. 

A preceding vehicle detecting block 53 receives data 
20 regarding the obstacle (including the vehicle probability and 

the same lane probability) from the target model formulating 
block 43 and selects a preceding vehicle that is closest to 
the vehicle carrying the obstacle detection system. Also, a 
distance Z between two vehicles in the Z-direction and a 
25 relative speed Vz in the Z-direction are calculated. A 

vehicle control and alarm block 55 operates an alarm 
generator 13 if it is determined that such is necessary based 
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on the various data including the distance Z, the relative 
speed Vz, a setting status of a cruise control switch 26, a 
condition of a brake switch 9, an opening degree of a 
throttle fed from a throttle sensor 11. If it is determined 
5 that a cruise control of the vehicle is to be performed, the 

vehicle control and alarm block 55 operates, in a controlled 
manner, the automatic transmission controller 23, the brake 
driver 19, and the throttle driver 21. The status of the 
various controls is displayed on the distance display 15. 

10 It is important to correctly detect the obstacle such 

as a preceding vehicle in order to suitably perform the 
vehicle controls and the alarming operations described above. 
The target model formulating block 43 formulates the target 
model for correctly detecting the obstacle in the manner 

15 described below. 

FIG. 4A shows a main process of detecting the obstacle. 
At step S110, data regarding the reflected beams fed from the 
laser radar sensor 5 are read for each scanning line. The 
scan period is 100 ms, i.e., all the position data covering 

20 the entire detection area 91 are read every 100 ms . At step 

S120, a segmentation process in which the position data are 
grouped into the segment data is performed. The segmentation 
process includes a process of forming the presegment data and 
a process of forming the main segment data. 

25 In the process of forming the presegment data, the 

position data that satisfy a predetermined grouping 
conditions are selected from among all the position data 
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shown in the X-Y-Z coordinate for each scanning line. The 
selected position data form the presegment data for each 
scanning line. Position data plotted on the X-Z plane are 
shown in FIG. 5A as examples. Position data in the Y- 
5 direction are not shown because they are uniquely determined 

by the scanning angle (0.7° for each scanning line). The 
grouping conditions consist of two conditions: one condition 
is that a distance AX between two neighboring dots in the X- 
direction does not exceed 2 0 cm (AX < 2 0 cm) ; and the other 

10 condition is that a distance AZ between two neighboring dots 

in the Z-direction does not exceed 5 m (AZ < 5 m) . The 
position data satisfying the grouping conditions are grouped 
into one presegment data for each scanning line. 

In FIG. 5B, one presegment data having a width wa in 

15 the X-direction and a depth da in the Z-direction, and the 

other presegment data having a width wb and a depth db are 
shown. The size of the presegment data (width x depth) is 
set to such a size that encompasses therein all the position 
data satisfying the grouping conditions. Each segment data 

20 consists of its center position (X,Z) and its size (W,D). 

One segment data exemplified in FIG. SB has its center 
position (xa, za) and its size (wa, da) . The other 
presegment data has its center position (xb, zb) and its size 
(wb, db) . 

25 In the process of forming the presegment data, the 

process is initiated at a center (X, Z) of a preceding 
vehicle when the preceding vehicle traveling on a curved road 
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is continuously detected. When the preceding vehicle is not 
continuously detected, the process is initiated at a 
reference angular direction P which is determined from the 
radius R of the curved road and the vehicle speed. A 
particular beam number corresponding to the reference angular 
direction is referred to as an objective beam number at which 
the segmentation process is initiated. 

As shown in FIG. 6, the objective beam number is 
determined from an angular difference between the center 
direction (corresponding to the center beam number) and the 
reference direction P (corresponding to the objective beam 
number) . By initiating the process of forming the presegment 
data from the objective beam number, the preceding vehicle 
can be surely detected even when the own vehicle 300 is 
traveling on a curved road 320 along a curved line 330. 

How the objective beam number is determined will be 
explained referring to FIG. 7. When the preceding vehicle is 
stably detected, the objective beam number No from which the 
segmentation process is initiated is determined from the 
center position (X0, Z0) of the preceding vehicle according 
to the following formula . 

No = Nc + (X0 + AX) x 180 + (0.15 x n) -5- Z0 (1) 

Nc is the center beam number, which is 53 because one 
scanning line in the X-direction consists of 105 beams. 0.15 
in the formula (1) represents an angle between two 
neighboring beams. AX is an offset amount of a mounting 
position of the detection system 350 relative to the turning 



center 100 of the vehicle 300, as shown in FIG. 7. The 
turning center 100 is a point around which the vehicle 300 
turns when the vehicle is steered. 

It is possible, however, to determine the objective 
5 beam number according to the above formula (1) only when the 

following conditions are satisfied: (a) The preceding vehicle 
is continuously detected as a moving object for a certain 
period, (b) A changing rate of a relative speed between the 
detected object and the vehicle is smaller than a certain 

10 level. Stationary objects repeatedly detected (such as 

roadside poles) may be misjudged as a moving object. Such a 
misjudgment can be eliminated by applying this condition, (c) 
The same lane probability (explained later) is higher than a 
certain level, (d) The vehicle is traveling on a curved road. 

15 If the vehicle is traveling on a straight road, it is 

preferable to initiate the segmentation process at the center 
beam, not at the objective beam number determined according 
to the formula (1), in order to secure a wide detection area. 

If plural preceding vehicles that satisfy the above 

20 conditions are detected, one preceding vehicle that is 

closest to the own vehicle is selected. The segmentation 
process is initiated from the beam number corresponding to 
the center position (X0,Z0) of the selected vehicle. 

When the preceding vehicle is not continuously 

25 detected, the segmentation process is initiated from the 

objective beam number determined as follows. A position 
where the preceding vehicle is most probably located is 
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presumed based on a reference distance in the Z-direction and 
a calculated radius R of a curved road. The reference 
distance corresponding to a traveling speed of the vehicle is 
predetermined, so that the reference distance becomes longer 
as the vehicle speed becomes higher. This is because a 
distance between two vehicles is usually set longer as the 
vehicle speed becomes higher. 

The presumed position (X0,Z0) of the preceding 
vehicle is expressed according to the following formula by- 
setting the reference distance in the Z-direction to ZO 
(refer to FIG. 7) . 

XO = Zr 2 /2R; Zr = ZO + AZ (2) 

Alternatively, the position XO in the X-direction can be 
calculated according to the following formula. 

XO = (No - Nc) x ZO x 0.15 x n + 180 - AX (3) 

In the above formulae, No is the objective beam number, Nc is 
the center beam number and AX is the offset amount of the 
detection system 350 relative to the center direction, as 
shown in FIG. 7. From the formulae (2) and (3)., the 
following formula is derived, and the objective beam number 
No is determined. 

No = Nc + (Zr 2 /2R + AX) x 180 ~ (0.15 x n) Z (4) 

The process of forming the presegment data is 
initiated from the objective beam number determined as above, 
and position data are sequentially selected from both sides 
of the objective beam number to form the presegment data. 
This process will be explained with reference to FIG. 8. The 
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presegment data ® is formed at the position of the objective 
beam number, and then the presegment data ® is formed at the 
right side of the objective beam number by searching the dot 
data satisfying the grouping conditions. Then, the 

5 presegment data (3) is formed at the left side of the 

objective beam number by searching the dot data satisfying 
the grouping conditions. After the presegment data (2) and (D 
are formed at both sides of the objective beam number, a 
distance of (D from the objective beam number is compared 

10 with a distance of (3) from the objective beam number. In 

this example, the position (2) is closer to the objective beam 
number than the position (3). Therefore, after the presegment 
data (3) is formed, the next presegment data © is searched at 
the right side of the objective beam (the side of the (D 

15 position) . After the data ® is formed, a distance of (3) 

from the objective beam number and a distance of (D from the 
objective beam number are compared. The next data is 
selected from the side closer to the objective beam number. 
Similar process is repeated until a predetermined number of 

20 dot data is grouped in the presegment data. 

In the conventional system, reflecting dots located 
at one side of the objecting beam number are first picked up 
for forming the presegment data, and then reflecting dots 
located at the other side are picked up. If a predetermined 

25 number of data to be included in the segment data is picked 

up from one side of the objective bean number, no other data 
can be picked up from the other side even if there is a 
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preceding vehicle to be detected. In the system according to 
the present invention, data close to the objective beam line 
are surely grouped into the presegment data, because the 
reflecting dots are picked up alternately from one side and 
5 the other side of the objective beam number. 

The number of data to be grouped in one presegment 
data is predetermined for each scanning line. In this 
particular embodiment, there are six scanning lines as shown 
in FIG. 3. The predetermined number is set for each scanning 

10 line as follows: 12 each for the third line and the fourth 

line; 8 each for the second line and the fifth line; and 4 
each for the first line and the sixth line. The reason for 
setting these numbers is to save a memory capacity of RAM and 
to shorten a period of time for data processing. Higher 

15 numbers are set for the scanning lines close to the center of 

the detection area 91, while lower numbers are set for the 
scanning lines located at the edges of the detection area. 
This is because, it is highly probable that the obstacles to 
be detected are at the center portion of the detection area. 

20 Now, the process of forming the main segment data 

will be described with reference to FIGS. 9A and 9B. When 
the presegment data of the same scanning line or the 
neighboring scanning line satisfy the grouping conditions for 
the main segment data, these data are grouped into a main 

25 segment data. In this embodiment, the maximum data number in 

the main segment is set to 16, and the grouping process 
proceeds from the first scanning line toward the sixth 
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scanning line until the data number reaches 16. It is also 
possible to start the grouping process from the scanning 
lines close to the center of the detection area, e.g., from 
the third scanning line or the fourth scanning line, which 
5 have a higher probability to include necessary information. 

The main presegment data is shown in the orthogonal 
coordinate having the X, Y and Z-axis (FIG. 9B) . The center 
position of the main segment data is (X, Y, Z) . It has width 
W in the X-direction, depth D in the Z-direction and height H 

10 in the Y-direction. All the presegment data that satisfy the 

grouping conditions for the main segment data are encompassed 
in the main segment having the size (W, H, D) . 

As shown in FIG. 9A, the presegment data of the 
first scanning line has its width wl, depth dl, and its 

15 center position is (xl,zl) on the X-Z plane (referred to as 

the presegment data (wl,dl), (xl,zl)). The presegment data 
(wl,dl), (xl,zl) is converted to a main segment data 
(W1,H1,D1), (X1,Y1,Z1). In this conversion, Wl and Dl are 
the same as wl and dl, respectively, but HI is a length in 

20 the Y-direction on the X-Y plane corresponding to the 

scanning angular interval 0.7°. XI and Zl are the same as xl 
and zl, respectively, but Yl is a length in the Y-direction 
on the X-Y plane corresponding to the angle (0.7° x 2.5) made 
by a beam scanning the first line and the Z-axis. 

25 Then, a main segment data (W2 , H2 , D2 ) , (X2 , Y2 , Z2 ) for 

the second scanning line is formed by combining (or grouping) 
the main segment data (Wl, HI, Dl) , (XI, Yl, Zl) converted from 
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the presegment data of the first scanning line with the 
presegment data (w2, d2 ) , (x2, z2) of the second scanning line, 
if the grouping conditions are satisfied. W2, D2 are set to 
include both of the area defined by Wl, Dl and the area 
defined by w2, d2 on the X-Z plane. H2 is a length on Y-axis 
corresponding to the two scanning angle intervals (0.7° x 2). 
X2 and Z2 are calculated as a center of an area defined by W2 
and D2, and Y2 is a length on the Y-axis corresponding to an 
angle (0.7° x 2) made by a beam directing a center of the 
first and the second scanning lines and the Z-axis. The 
process of forming the main segment data is repeated up to 
the sixth scanning line. 

The grouping conditions for the main segment are as 
follows: a distance between two data in the X-direction does 
not exceed 20 cm (AX < 20 cm) , and a distance between two 
data in the Z-direction does not exceed 5m (AZ ^ 5 m) . These 
two conditions are the same as those for forming the 
presegment data. In addition to these two conditions, one 
more condition is set for forming the main segment data. 
That is, only the data on the same scanning line or the 
neighboring scanning lines can be grouped into the main 
segment data. The data that satisfy all of these three 
conditions are grouped into the main segment data. 

Now, a process of forming a target model that is 
performed at step S130 shown in FIG. 4A will be described. 
Detailed steps of this process are shown in FIG. 4B. At step 
S131, a main segment data corresponding to a target model 
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that is formulated in the previous detection is searched from 
among the main segment data formed in the present detection. 
In this searching process, a presumed target model position 
is calculated from its previous position, on the assumption 
5 that the target model has moved from the previous position at 

a relative speed which is measured at the previous detection. 
Then, a certain tolerance range is given to each position in 
the X, Y and Z directions. The main segement data, at least 
a portion of which is included in the tolerance range, is 

10 determined as the main segment data of the present detection. 

If the new main segment data that satisfies the 
above conditions is found, the previous target model is 
renewed based on the new main segment data. The renewed 
target model includes a center position of the main segment 

15 data (X,Y,Z), its size (W, H, D) , its moving speed (Vx, Vy, 

Vz) in the X, Y, Z-directions relative to the own vehicle, 
and data showing the center position obtained at past four 
detections. If no main segment data that satisfies the above 
conditions is found, the target model is not renewed, and the 

2 0 previous target model remains unchanged. 

At step S133, the vehicle probability, i.e., a 
probability that the target model represents a preceding 
vehicle, is calculated based on its relative acceleration, 
shape, position and detected period. The vehicle probability 

25 falls in a range of 0-100%. To eliminate any instantaneous 

deviation or disturbance due to noises, the vehicle 
probability is obtained by averaging its plural instantaneous 
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values. The process of calculating the vehicle probability 
is disclosed in JP-A-2002-40139 in detail. Therefore, it 
will not be described here in detail. 

At step S134, the same lane probability, i.e., a 
5 probability that the target model represents a preceding 

vehicle which is traveling on the same lane as the own 
vehicle, is calculated in the following manner. The position 
of the target model is converted to a position on a straight 
road based on the radius of the curved road calculated in the 

10 curve radius calculating circuit 57 (shown in FIG. 1) . Then, 

an instantaneous same lane probability is obtained by 
overlapping the converted position on a same lane probability 
map that is predetermined. The same lane probability map 
shows respective probabilities in sections formed by dividing 

15 a frontal area of the own vehicle. For example, a frontal 

area having 5 m at each side of the vehicle and 100 m in 
front of the vehicle is divided into plural sections. The 
same lane probability is given to each section, so that the 
probability becomes higher as a given section is closer to 

2 0 the own vehicle. 

A value of the instantaneous probability calculated 
as above and its previous value are averaged using a certain 
weighing factor, thereby obtaining the same lane probability 
to be fed to the block 53 (shown in FIG. 1) . Since the 

25 process of calculating the same lane probability is also 

described in detail also in the above publication, JP-A-2002- 
40139, no further explanation will be given here. 
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After the target model is formulated as above, the 
target model is fed to the preceding vehicle judgment block 
53 (shown in FIG. 1) together with the vehicle probability 
and the same lane probability. The preceding vehicle 
judgment block 53 determines the target model that has a 
predetermined vehicle probability (e.g.,- higher than 50%), a 
predetermined same lane probability (e.g., higher than 50%) 
and a distance in the Z-direction closest to the own vehicle 
as a preceding vehicle. Then, the distance Z between the 
preceding vehicle and the own vehicle and a relative speed Vz 
in the Z-direction are fed to the vehicle control and alarm 
block 55. Thus, an inter-vehicle distance is controlled, and 
proper alarms are generated based on the distance Z and the 
relative speed Vz . 

The present invention is not limited to the 
embodiment described above, but it may be variously modified. 
For example, the polygon mirror 73 having different slant 
angles used for scanning the two-dimensional detection area 
91 may be replaced with a galvano-mirror having a mirror face 
a slant angle of which is controllable. Though the scan 
angles 9x and 9y are converted from the polar coordinates to 
the orthogonal coordinates in the laser radar sensor 5 in the 
foregoing embodiment, it is also possible to perform that 
process in the target model formulation block 43. 

Though the detection of the obstacle is performed by 
emitting the laser beam in the foregoing embodiment, it is 
also possible to perform the detection using other beams such 



as electromagnetic millimeter waves or ultrasonic waves, as 
long as a distance between a frontal obstacle and the own 
vehicle and an angular direction in which the obstacle is 
located are detected. When an FMCW radar or a Doppler radar 
emitting millimeter waves is used, it is not necessary to 
calculate a relative speed based on the distance data as done 
in the system using the laser radar, because the speed 
relative to the preceding vehicle is obtained together with 
the distance data. 

While the present invention has been shown and 
described with reference to the foregoing preferred 
embodiment, it will be apparent to those skilled in the art 
that changes in form and detail may be made therein without 
departing from the scope of the invention as defined in the 
appended claims. 



